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Abstract 


H i r*f** n****** ^!*^* »ethod* for tbc deeiga of adaptive force cad poaltl oa 

coatrollcra for robtft ■aalpolators within the hybrid coatrol architcctBrc^^lfc^ / 

fores eoatrolisr ia eoapoaad of aa adaptive PID feedback eoatroller, an 
aatiliary aitaal aad a fores feedforward tera; aad it aebievea tracklag of 
desired fores aatpolata ia the eoostraiat directioaa. The positioa eoatroller 
eoaaiata of adaptive feedback aad feedforward eoatrollers aad aa aoailiary 
sigaal; aad it aeeoapliahea tracklag of deairad positioa trajectories ia the 
free direetioaa. The eoatrollers are capable of compensating for dynamic crosa- 
oonpliags that eaist between the positioa aad force coatrol loops ia the hybrid 
control architecture. The adaptive controllers do aot reqatre knowledge of the 
eoaplea dynaaic aodel or paraaetar values of the aanipalator or the envlroaaeat. 

The proposed control scheaes are eoapat a t ioaa 1 ly fast aad saitable for 
iapleaeatat loa in oa-liaa control with high saapling rates. 
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1. Introduction 

Although control of robot manipulators hat been studied extensively in recent years, this study has been 
focosed primarily on position control of nenipulators in free notion within sn unconstrained environsient. In 
■any practical applications, the aianipnlator is constrained by the environaent and certain degrees-of-freedr m 
are lost for notion doe to environnenta 1 constraints. Vhea the nanipnlator ashes contact with the environaent, 
the contact forces nnst be controlled in the constraint directions, while the positions are controlled 
siaultaneously in the free directions. 

The problen of nanipnlator control in a constrained environnent has been investigated by several 
researchers (1). At present, three najor conceptual approaches exist for sinnltaneous position and force 
control. Panl and Shinano (2) suggest a nethod which uses certain Joints for position control while the 
renaining joints are used for force coatrol. Salisbury (31 puts forward a technique for controlling the end' 
effector stiffness characteristics la the Cartesian space. Raibert and Craig [4] propose a conceptual 
architecture, based on the analysis of Nason (31, for "hybrid control” which allows forces to be controlled in 
the constraint directions by a force controller, while simultaneously controlling positions in the free 
directions by a position controller. Raibert and Craig, however, do not prescribe a general and systsaatic 
■ethod for the design of position and force controllers. Nevertheless, hybrid control has gained considerable 
popularity over the other two alternatives for siaultnneous position and force control [6-131. 

The present paper pots forth systeaatic nethod* for the design of adaptive force and position controllers 
within the hybrid control architecture. The force controller achieves tracking of desired force setpoints, 
while the position controller accoapl ishes tracking of desired position trajectories. The force and position 
controller gains are generated by adaptation laws by neans of siaple arithmetic operations, and thus the 
controllers are conputa tionally fast and suitable for on-line iapleaentat ion with high saapling rates. The 
adaptive controllers do not require knowledge of the complex dynaaic aodel or parameter values of the 
aanipulator or the environaent. 

The paper is structured as follows. In Section 2, the hybrid control architecture Is outlined and the 
problea is stated. 'Section 3 addresses the design of force control systea using aodel reference adaptive 
control (MRAC) theory. The design of position control systea is discussed briefly in Section 4. In Section 5, 
the force and position controllers are integrated in the hybrid control architecture. Finally, Section 6 
discusses the results of the paper and draws soae conclusions. 
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2 . 


Problea Stateaeat 


la thi> aaotioa, tha hybrid force/poai tioa* eoatrol architects™ is discussed briefly, and the fora* aad 
position tracking eoatrol problcaa are atatad. 

Lot as coasldsr a robot aaalpalator which parforas a aaabar of dlffaraat taaha la a Cartaalaa tpae* (X). 
Each task, ia general, tavolves aotloa of the aaalpalator end-effector la eartaia direetloas aad, 
sianltaneously, esertlon of force by tha asd-affaetor oa tha eavlroaaeat ia tha raaaiaiag diraatioae (Si. Tha 
dlraetioae of aotloa aad fores dspaad oa tha aatara of tha partiealar tack to be perforaed aad are reflactod la 
the "task aatrla" la tha hybrid eoatrol arehitaetara shown la Fignre 1. The tack aatrix also eoatala* the 
t raasforaa t loan repaired to aap the aeasarsaeats £ and £ t of- Joiat encoders and fores / torq", taatora late 
position aad fores variables la the eoaetralat fraae daflasd with reapaet to the task geonetry (41. Not* that 
the desired fores and position trajeetorlsa ars slso specified ia the eoaetralat fraae. For any give* task, 
the a-diaensloaal Cartesian spaea (X) eaa be deeoaposed into two orthogonal l- aad a-dlasnstoaal sabspacas (T) 
aad (Z), where a ■ l * a. Tha "position sabspaea" (T) contains the t direetloas (i.e„ degree s-of-freed*») la 
which tha aaalpalator and-affaetor Is free to aovs sad aloag which aad-affaeto r nos It ton 1s to bs control led. 
The "fores sabspaee" (Z) contains the reasialag a direetloas ia which the aaalpalator cad-effector Is 
constrained by and interacts with the eoviroaaeat aad along which tha ££lig£l fo rce Is to be controlled. 

In the hybrid foree/pos I t ion eoatrol problsa addressed la this paper, ns consider tha "vlrtnel" Cartaalaa 
force £ acting on the ead-effeetor as tha aaaipnlated variable and the position or force of the ead-effeetor sa 
the controlled vsrisbles (14). The hybrid control architects™ is based on two Independent and noa-intaract lag 
controllers as shown la Fignre 1; naaely, tha position controller which operates in (T) aad tha force 
controller which sets In (Z). Tha position controller gsaeratss the Cartesian cnd-effactor force Ey repaired 
to cause the end-effector notion to track a desired position trajectory In (T). The fores controller produces 
the Cartesian end-effector force E x needed to ansars that tha end-effector force follows a desired fores 
setpoint in (Z). Since vs cannot physically apply Cartaalaa forces to the end-effector, we Instead eoapate aad 
iaplcnent the equivalent Joint torqnas needed to effectively canse these forces. The required joint torques 
ere obtained fron the Cartesian forces by naans of the Jacobian aatrix J(0) of the asnipnlator. where £ is the 
joint angle vector. 

We shall now sddress the probleas of force and position control separately In Sections 3 end 4 aad then 
integrate the results in Section 3. . 


3 . Design of Force Control Systea 

In this section, a siaple dynaaic aodel for forca control in the subspace (Z) Is described, nad se 
adaptive force control achene is developed, 

3 . 1 Dvnaai c Force Mo del 

The full dynaaic aodel of the end-effector plua force/torqoe sensor la contact with tha esviroanaat is 
coaplex [13], However, tha dynaaic behavior of this systea esn be aodelled approxiaately by a asss-spring- 
daaper in each degree-of-freedoa as shown la Fignre 2 and described by the differential equation 

a 2(t> e d aft) ♦ k lit) - fit) (1) 

Generalising this siaple aodel to the a-diaens ional forca tsbepaca (Z), the dynaaic behavior of the ayataa ia 
(Z) can be expressed by tha differaatial equation 

*oZ<t) ♦ DgZi t ) ♦ X,z<t) - E,(t) (2) 

where Jit) is 'he axl end-effector positlon/orientatioa vector, M a ia the eyaaetrlc poe i t i ve-def in i t a axn 
generalised aass aatrix, D g is tha axa generalised daapiag aatrix, X # it the diagonal axa generalised stiffness 
aatrix and E, it the axl force vector applied to tha end-affector in tha forca sabspaee (Z). The eleaeats of 
X, are the "equivalent" translational (force) aad rotational (torque) coefficients of elasticity (stiffness) 
of the systea in various directions in (Z). By aa appropriate choice of the (Z) sabspaee origin, th* axl 
force/torque vector P(t) exerted by the end-effector oa the esvlronaent is related to Z(t) by the 
general ixetion of Booke's law aa 


E<t) - X, Z(t) (3) 

Froa equations (2) and (3), we obtain 

A P(t> ♦ B P(t) e P( t ) - E x (t) (4) 

where A - N () IJ 1 and B - D 0 X^ 1 are axa aatrices. Equation (4) gives s siaple dynaaic aodel of the systea ia the 
force subspsce (Z). Since the aanipulator dynaaics is highly nonlinear, the aatrices A aad B in equation (4) 
are dependent on the end-effector Cartesian position and velocity vectors X and ( and also oa the ayataa 
paraaetera such as the equivalent stiffness and the payload aass, which are represented by the parsaeter v*ctor 
p. Furtheraore, due to internal crosa-conpl ing of the aanipnlator dynaaics. a "disturbance" tern Cp(I) asst he 
Included in equation (4) to represent the dynaaic coupling froa the position loop into the force loop, wb«re I 


* In this paper, "position" inplles position and orientation and "force” iapliea force and torqne. 
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ia tka emd-ef factor poaitloa neater la (T). Till, a aor* xillttli aodal far feta* control it oktaiaed ta 

♦ r<«> ♦ £,<i> • e t (o <s> 

Eq nation (S) it a aat at klgkly eoaplex aaaliaaar end coupled eaeoad-order differential eqaationa. 

1.2 Foraa Coatrel lakaao 

la order ta aoatral tfca foree/torqae J(t) esorted ky tka ead-effeetor aa tka aaviroaaaat, lat aa eaploy a 
NS aaatrailar *itk adaption gaiae (1^(1), I|(t), Kp<t)) aad aa auxiliary ai|aal Hi) ia tka foraa aaatrol lav 

I,(t) - r,(t> ♦ 1,(1) I(t) ♦ Kj(t) J^KOdt * tyt) i(t) a |(t) <d) 


• kero t,(t) ia tka aal neater ef daairad faraa trajeatory need aa a feedforward tara, aad tka axl foraa 
Uaekiag-arror naetor |(t) - *,<»> - ((t) ia tka deniatiea of tka aataal (aaaaarad) faraa frea tka daairad 
valma. liaaa ia practical appllaatieaa tka daairad faraa trajectory ia vary aftaa a aaaataat aatpaiat l r lt) • 
f r> tka NS aaatral law ia pertioalarly aaitakla far tkia aitaatlaa. Fartkeraorc, tka aaailiary ai|aal fit) 
•aapaaaataa far tka eroee-aoapllag tara £, aad tka tiaa aad paraaatar vatiatiaaa of A aad > aatriaaa. Nett 
tkat tka faadfarward tara l ( (t) ia iaaladad ia tka aoatral law (d) aiaaa ideally wt waat J(t) ■ f t (t). la 

agnation (I). tka gaiaa of tka PIS aaatrailar. aaaaly Ip(t), Ij(t) aad K D (t). aad alaa tka aaailiary eigaal 

|(l) ara adapted ia raal-tiaa ta aaaaapliak faraa aatpaiat tracking ia apita of tka aaaliaaar aad poaaikly tiaa- 
t ary lag kakawiar ef tka ayataa aodal (S). 

Oa apply tag tka liaaar aaatrol law «) to tka ayataa aadal (5). wa ektaia 

A 2(0 ♦ ■ f(t) ♦ f(t) ♦ £, - E f (t) ♦ Ip*(t) ♦ tj ^**(t)dt ♦ KptCt) ♦ i(t) (7) 

Da lag B ( t > - t r (t) - [(t) aad aotiag tkat E<*> • -fc(t) aad E<t> - -f(t) for a aaaataat daairad force, equation 
(7) aaa ka writtta aa 

|(t) ♦ A*‘(l ♦ I D ) |( t ) ♦ A~ 1 (l * I,) B<t ) ♦ A _1 l! B*(t) • A -1 I£p - Bit)] (I) 


wkara B*(«) • f * {(t)dt ia tka aal latagral error Taator. Kquatioa (I) aaa ka aaprataad ia ataadard atate- 
•paaa fora aa 



(9) 


la tka 3ail aagaaatad error rector. 


Enaction (9) eoaatltataa tka "adjaatakla ayataa” ia tka NBAC fraaeuork. 


Now. la tka Ideal altmatioa. tka daairad bekawior of tka force error E a (*) 1* daacrikad ky tka koaogeaeome 
diffaraatial aquation 

1,(1) • Dj8.(l) a 026 ,( 1 ) ♦ DjE^U) • 9 (10) 

wkara Dj. Dj aad Dj are coaataat ara aatriaaa wkick ara ckoaaa aaak tkat equatioa (10) la atakle aad aakodiaa 
the desired p«rforBisc« of tk« fores control sjilta. By ckooslag Dj. Dj aad Dj as diagonal sitrien, tbo fores 
•rrort will bs decoopled; for listaici 

• dj (t > • dji^i < t > • di^EgjU) • 0 (11) 

vbers the coefficients dj j, djj sad dj j srs chosen snch that the t reck isg-e r ro r £j(t) * P rl U) - P^(t) has • 
desired behavior aad ^2i^3i * ^li to •■••re ttability. Eqsetioa (10) eaa be written as 

( 0 r - M 

I a (t) - 0 0 I, g a (t) - 0 g a (t) (12) 

\ ‘“I -®J -»3 / 

wkara J^(t) - I E,(t) I ia tka 3axl daairad error rector. Equation (12) coaatitntea tka "reference aodal* in 

V *-<*>/ 

tka coatait of KRAC tkaory. Slaea tka initial rnlnaa of tka actual aad daairad forcaa ara often tka aaaa, tfca 
initial error g a (0) ia equal to aero, aad kaaca froa aquation (12). g a (t) * axp(Dt] • g a (0) - g for all t. 
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Now, is or4ar tor tka UJiilitU igritu 
aayaptotlaalljr, ftoa lafaraaaa [1<] aa iiyiln 


0 I " « 5 ‘ «i. ♦ < *i. 

A-li/ 


f: : :).*«( 

A" 1 *, A-lt./ V 


«l*a 0 0 

0 »ll- 0 

• 0 rxL , 


/ «ala 0 • \ 

♦ M [ 0 »jl» « I <!»*> 

\ o o n 1 / 

ahara * ' * daaotaa traaapoaitioa. Caj, (j, Tl ) ara poaitiva aaalart, (oj. fj. r]) ••*• •* paaitlaa 

(•alar*. aad L la aa aia asaataat aatrii ta la tpaaifiad latar. Ia aqaatioa (11). Q 0 aa4 Qj t*o apaaatrlt 
poaitlaa-daf ialta laila aatriaaa, Q* aa4 Qj art apaaatria poaltiaa aaa i-4af lal ta laila aatriaaa. aa4 tka 
apaaatria poaitiva-daf laita laila aatrit 


/ “l «2 «1 \ 

- "l "4 "5 

\"l "5 «d/ 


ia tka aelatioa of tka Lpapaaov aqaatioa for tka rafaraaaa ao4al (12). aaaaljr 

N D ♦ D'N - -N (14) 

wkara N ia a araaatrla poaitiva-daf laita laila aatrii. Ia 4ari*ia| aqaatioa (11). tka aatriaaa i I. aa4 £. *■ 
tka robot ao4al (5) ara aaaaaa4 to ba aakaoaa a ad "alow Ip tiaa-varplag* aoapar#4 with tka a4aptatioa algorilka. 
aiaaa tkaaa aatriaaa eaaaot okaaga aigaif iaaatlp la aaok aaapllag latarval akiak ia of tka or4ar of a 
• 11 1 ltaaoad. Now, ia or4ar to aaka tka aoatrollar a4aptatioa lawa la4aoaadaat of tka ao4al aatrii A, wa akoaaa 

0 o ■ | A* i Qj “ ** 1 °o * > ®I ■ IA»J _1 (IS) 

abort (Ij, »j) art poaitiva aad aaro or poaitiva acalara, aad 

/a 0 0 \ 

A* • I 0 A 0 la a apaaatric pot itloa-daf ialta 3ax)a aatrii. 

\ 0 « * / 

Sobititatiag froa tqaatloa (IS) iato aqaatioa (13), aftar aiaplif ioatioa aa obtala tka adaptatloa laaa 


i(t> - *ja<«> * bji(t) 

(14) 

ij(t) - ujlait) B»'(t>) ♦ tj ^tg(t) £•’(*)) 

(17) 

ipft ) - p 1 l a (t) fi ’ ( t > 1 ♦ fi 2 B’(‘>1 

(11) 

V‘> - Tita(t) gMtlLl ♦ T2 B'(t)L) 

(If) 


abort g(t) it tht ail "wtigkttd" foret trror vtotor dtfiaad at 

g(t) • N, gt( t) ♦ H s £(t) ♦ Mg I(t) (20) 

aad N], Mj, Ng art approprlatt tabaatrictt of N. That. tht raqairad aailliarp tigaal aad P1D eoatrollar gaiat 


4(t) - j(0) ♦ &j / 0 l a(t>dt ♦ bjg(t) 

lj(t) - C,(0) ♦ •ifn a<*> £•'( t )d t ♦ « 2 q(t> E*'<t> 
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1,(0 - 1,(0) ♦ Oi /„*!<«> |‘(t)0t ♦ 02*<‘> !'<*> <M) 

10(0 - lp(0) * n / 0 *«(O B’diUt ♦ Tjl(*> l'(OL (24) 

lbo (wh Mill*) In it tbaa giTta by 

I g (t> - l t (0 * 4(0 ♦ Kj(t) / 0 'l(t)4t * E,(t>B(t> ♦ 10(1)1(0 (IS) 


It it ittii that tbt aaaiiiary aigaal J(t) tta bo gtaaratad by a PI*D toatrallar drivaa by tkt fartt arror |(t) 
tiatt. fraa agaatioaa ( 30 )— ( 21 ), |(t) tta bt aapraaaad tt 

4(0 - 1 ( 0 ) ♦ (•]M i )|(t) ♦ [« t Hf ♦ OjMjlKO 

♦ l», « 5 ♦ »l"|l ♦ I*!"! 1 / 0 ‘ {/ 0 ‘» <,,4 »} 4t 

la yrtttittl iayltataittiaa of a ay fartt aaatrol la*. 4 if fartatlaiiaa of tbt aoiay fortt aattartaaat f(t) 
it aadaairabla aa 4 , aoraovar, dlfftrtat lat loa af tbt aaatttat fartt tttyaiat [, prodaata aaviattd iayaltat. 
Tbit argaatat aaggaata that tba darivatira |(t) ia agaatiaia ( 20 ), ( 24 ) tag ( 25 ) aait bt rapltaad by - 1 , 2(0 
atiag agaatiaa (J>. Tbit yitlgt tbt liatar adaptive fartt taatral lta 

C,(t) - r f (t) * 4(0 ♦ Ii<t) J^BUldt ♦ K,(t)|(t) - t,(t)Z <0 (20 

• bitb it tbaaa ia rigart J, abtra l T (t) - l D (t)l, la tbt tit rtloeity fttdbaak gilt attrii tad tba tara 


£,(1)2(0 rtprtatata velocity daaplag. Cbooaiag L > (IJ*)*» tba tdaptatioa 


1(0 - 4(0) ♦ * x / 0 

*i(t)dt ♦ »j*(t) 

(27) 

I|(t> - Ij(O) * aj 

4*l(t)B*’(*)dt ♦ ajllOB'Mt) 

(21) 

lp(t) - 1,(0) ♦ fj 

/ 0 ‘g( *)B'«t)di ♦ » 2 i(OB*(t) 

(29) 

l*(t) ■ 1,(0) - Tl 

/« «(OZ'(t)dt - Tii<Ol'<t) 

(30) 


•bart 


g(t) - »,*•(») ♦ M]B(t) - MgZ(t) (31) 

tad a J » It tta bt tbaaa that by yreyar taltatiea ef aatria N ia tbt Lyapaaov tfutlei (14). tba 

tabattrittt Mj, I j tad lg ia agattiaa (20) tta bt aada tgaal ta tbt datirtd relate * j, V, tad Ip - I,!,' 1 
raipattiaaly. tad baata tgaatlaa (31) bttoatt 

1(0 - WjBtft) ♦ Wp*(t) - 1,2(0 (32) 

vbara f j, V, tad I, art tbt an ditgoaal atigbtitg attricta tbaata by tbt daaigaar te rafltat lit ralatire 
aigalfittatt af tba iatagrtl trrar (*• tba fartt trrar B> tad tbt reloeity Z* reepeetirtly. Proa eqaatioaa 
(27)-(30), tbt gtaaral txprtaaloa for a typloal eoatrollar |aia I(t) *bieb acta oa tbt aigaal j(t) to (taarata 
tba tara Ht)x(t) ia tbt toatrol It* (24) cat bt arittta at 

1(0 - 1(0) ♦ pj ^'i(t)j'(t)dt ♦ Pji(t)x'(t) (33) 


• bart i»i tad |i] art attlar gaiaa. Tbia eoapatatioa caa bt ptrforatd by a aiaplt "adaptation aodaia* ahn*a ia 
tba block diagraa of Flgart 4 (For 4(0, *a att x - 1). Tbt tdaptatioa aodaia atta oa tbt tao lapat aigaala 
l(t) tad x(t) to prodaat tbt oatpat aigaal Kt)x(t). Tba forot toatrol It* (2d) tta thta bt coaatraettd by 
parallal coaaaatioa of foar aatb aodalta. 

Tba forca coatrol atbaat daralopad la tbia aactioa ia axtraaaly aiaplt, tiact tbt tdaptatioa lava (27)- 
(30) gtatrata tbt eoatrollar gaiaa by aaaaa of aiaplt latagratioa atiag, for iaataaet, tbt traptioidal ralt ia 
tgaatioa (33) eta bt iapltatattd ta 
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(34) 


fCi) • ^ ' It ♦ p<l-l>i'<i-l>J ♦ Mj(*<l)l'(l)l 


abort the lattgtr I (nolti tka taapliag lutut iU T, It tk* ui|Ui| period. At t rttalt. tkt fore* toatrol 
It* (20 eta b* tvaloat*.'* very rapidly tad eoaatqatatlp. tkt fort# coatrol taktat taa bt iapltatattd far rttl- 
tiat coatrol vitfc hi|k taapliag rattt (typically 1 Oft). flgh taapliag rttt It rtrjr dtt Iraki* ia tart* taatral 
tppllottioat tad yltldt laprovad djrataic ptrforatatt. Tkt tdtptatita la*t (2T)-(30) do aot rtqalra tkt 
aoapltx aaattaoar aodtl at aaaipalttor dyaaalat (3) or tap kao*ltd|t of paraatttrt of tkt aaaipalttor or tkt 
eavlroaatat. Tbit It dat to tkt fttt tkat tkt adaptive forta toatrolltr kt 1 "lttralag ttptbll Ititt* tad ata 
rapidly tdipt ititlf to irott ohaagtt ia tkt aaaipalttor or tkt tavlroaatat partatttrt. 


4. Dttlfa of Potltloa Coatrol Spttta 

Ia tklt ttttloB, t dpatalc aodtl for potitloa toatrol la tkt tabtpaiu <T) It dtttrlbtd tad ta adaptivt 
potltloa toatrol ttktat It briefly caplalatd. 

4.1 PlllMig..HUU 9 » Haiti ^ 

Tkt dpataltt of tkt aad-affactor la tkt Cartaalaa (past (XI taa kt rtprtttattd bp (14) 

A<I>t * id- >> * td) * f * E (33) 

• kart A It tkt Carttilta attt aatria, A It tkt Cartttlaa aaatrifaial, Corlollt tad frittloa vector. ± 1* tkt 

Ctrtatlta gravity loadlag vtctor. ( It tkt fortt vtttor tatrttd bp tk* tad-affattor ta tkt tavlroaatat. aad [ 

la t!ii gtacrtliitd "vlrtaal" Cartttlaa fortt vtctor applltd to tk* «ad-*f factor. It tk* potltloa aabtpao* (T). 
tqaatioa (33) caa b* vrittta at (17) 

A(J. j. p) ?(t> ♦ B(J. X. p) i(t> ♦ C„(X. I. p) I(t) ♦ 5 f (f) - ( y (t) (30 

vbtre the til attrlcca A. B, C 0 arc highly ooaplti toallatar faactloaa of X- X *»d tk* apttto ptraaattra p. £f 

raprttcati tkt dpaaalc ejapl lag affect fro* tkt fore* loop lato tkc potltloa loop which it a faaction of tkt 
fore* yctor g ia (Z). tad E p i* the 111 tare* vector applied to tkc cad-tff*ctor ia the potltloa labtpaot (T). 
Eqaatioa (30 it a act of bigklp coaplti aoal iatar tad eoaplcd ttcoad-ordcr difftrtatial tqaatioaa. 


4.3 Pot ltloa C oat rol 3 thf t 

Tk* Carttilta potltloa coatrol ichaa* it developed follp la Bcftrcacc (II). Por tk* take of coaplt ttattt, 
tk* ratal tt arc ta*aarii«d ia thit ttetioa. 

Tk* 1 iatar adaptivt potition control la* It glv«a by 

E y < t ) - I(t) ♦ X p (t)Ep(t) * t,(t'Ep(t) * C(t)|(t) ♦ B(t)|(t) ♦ A(t>l<t> ’ (37) 

mm ibovo is Figure 5 . vberr |(t) h tbs til rsfsrtscs fdsslrsd) position trsjsctory rsetor, 2 p(t) - |(s) - J(t) 
i» ths hi potitloa tracking-srror vector, |(t) it aa avsiliary signal* aad [Ip£ p ♦ aad (Cg ♦ B| ♦ Afc] art 

ths contributions das to ths fssdback aad fssdforvard ooatrollsrs rsspset ivsly. Tbs rsqnirsd tsxlliary aigasl 
sad controller gsiot srs adaptsd according to ths following lavs: 


Kt) - 

f(0) ♦ 

*1 f Q l(t)dt ♦ gjplt) 

(31) 

f p (t) 

■ Ip(O) 

♦ *i / 0 l<t>E p (t)dt ♦ *2£ <t, Ep' <l > 

(39) 

* T (t) 

• X ¥ (0) 

♦ nj / 0 i<‘>Bp(t)dt » >i 2 i(t)e p (t) 

(40) 

C(t) - 

C(0> ♦ 

“1 J^ldllMOdt * W2l <t) *'(t) 

(41) 

Bit) • 

BIO) ♦ 

71 f Q I<t)i'(t)dt * T2X<t)i , (t) 

(42) 

Ait) - 

A(0) ♦ 

Aj /g'lUJXIOdt * X 2 x(t)i(t) 

(43) 

weighted” positioa error rector tit) it defined ss 
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(44) 


X<») - ♦ *4,(0 

la aqaatloB* (JI>-(43), (»j, »j, qj, . r t , Aj ) aft positive taalara. (6j, »j, qj, pj, Tj. Xj) ara positive or 
taro laalata. aa4 aad I, ara weighting matrices apaeifiad bp tka designer to raflact tka relative 
•igaifleaaaa of tka poaitioa aad velocity arrora £p aad By Nota tkat froa aquations (3l)-(43), tka aoatrollar 
gain* aaa ka aoapatad nstag tka jm adaptatioa ’modal*" at la Saotloa 4 («qa. 33) akoat la Figure 4. It ta 
:•*■ tkat tka poattloa aoatrol aakaaa ia aatraaalp simple ataaa tka aoatrollar gala* ara obtalaad froa 
aquation* (JI)-(43) bp aiapla integration (aaah at trapaaoldal rala) aad that tka aoapatatloaal tlaa rtqalrad 
ta avalant* tka poalttoa aoatrol la* (37) la aatraaalp akort. Tkat, tka poaitioa ooatrol aakaaa aaa ba 
laplaaaatad for oa-llaa aoatrol *lth high sampling rataa (- 1 Us), raaaltiai la improved dpaaai* parforaaaea. 


■pbrid Foraa/Foaltloa Coatrol System 


Ia (aatloaa 3 aad 4. tka Cartaalaa aad-affaator foraat £ f aad £ y ara generated bp tka foraa aad poaitioa 
aoatrollara to aaaoapllah foraa aad poaitioa traakiag la (Z) aad (T) ra (post It* lp. tlac* Cartesian for*** 
aaaaot b* appliad to tka aad-affaator la praatlaa, tkat* aad-affaator foroaa aaat b* aappod late tka aqalvalaat 
Jolat torqaaa. Tkat, la ordar to implement tka fora* tad poaitioa aoatrollara. tka aoatrol la* la joint apao* 
la (i**a bp (IF) 


I<t) • J'(t) 


f ) 


(43 > 


*k*r* ( ia tka aal jolat angle viator, X 1» tka aal jolat torqa* viator, aad 3 ia tka aia Jacobian aatria of 
tka aaaipalator. *itk approprlat* reordering of tka aolaaaa of 3 if aasaaaarp. 

It ia laportaat ta aota tkat although tka fora* aad poaitioa aoatrollara art atparata la tha hybrid 
aoatrol araki taatara, tkara aaiata dpaaaio eroaa-aoapl lag from tka (ora* aoatrol loop iato tka poaitioa ooatrol 
loop tad vie* varaa. Tkla coapllag ia da* ta tka faet tbat tka aad-affaator dpaaaiaa la tka Cartaalaa apae* 
(X) la atroaglp croaa-eoaplad; i.a. tka appliaatioa of aad-affaator fora* ia aap diraatioa affacta tka aad- 
affaator poaitioa* ia all diraatioa*. Tka aroaa-aoapl iag affaata ara aodallad aa "disturbance* taraa Jp aad £g 
ia tka fore* aad poaitioa aoatrol loop*. Tka adaptive aoatrollara are eapabla of ooapaaaatlag for tbaa* 
diatarbaaaaa aad aalataiaiag a good traakiag parforaaaea. Tka abilltp to eop* *ltk oroaa-ooapl iag effect* In 
tka hybrid aoatrol arakitaetara la aa laportaat faatar* of tka adaptive aoatrol aehaaaa of Sactioaa 3 and 4. 


4. Dlaeaaaioa aad Coaelaaioaa 

Slapla adaptive fore* and poaitioa control aektaat for aaaipalatora ia a hybrid control architecture arc 
described la thia paper. Th* coatrol aehaaaa ara coapotat ioaal ly fait aad do not require th* coaplax dynaaic 
aodcl or paraaatar valuaa of th* aaaipalator or th* *avirona*Bt. Th* fore* and poaitioa control loopa arc 
atabl* aiac* th* daaiga la baaed ca th* Lyapunov aathod vhloh gaaraataaa atabilitp a* a by-product of the 
daaiga. 

Th*r* ar* eartaia diff«r«ae*a b#t*«*a th* proposed approach aad th* conventional hybrid control of Bsibart 
and Craig (4). Firatly, ia th* praaaat approach, th* fore* and poaitioa coatrol problems ar* formulated ia tb* 
Cartaalaa apac* with th* aad-affaator Cartaalaa force* aa th* aaaipulatad variable*; *h*r*a* la [4). tb* 
problaaa ar* formulated ia th* Joint apnc*. Th* proposed foraulatioa raaalt* in coaputa t ioaal iaprovcaaat 
aiac* invera* Jacobian* ar* not a**d«d it tb* coatrol loopa. Secondly, in th* propoaad approach, th* 'tack 
aatria* operator on th* n«*aur*d variahl** ao aa to prodeea th* poaitioa and fore* variabl** that a*«d to b* 
control lad; viirtai ia (4), a selection aatria aad Its conpleneat ar* used after foraation of tracking-errors. 
Th* preaeat approach aceaa nor* a tra i ghtf orvard and appeal lag tbaa th* conventional approach. 

Aa attractive feature of the adaptive controller* deaigaed in thia paper ia their abilitiea to coapcnsate 
for dynaaic croaa-coupl iag* that axial between th* poaition aad fore* coatrol loopa ia th* hybrid control 
architecture. Furthernore. th* adaptive force aad poaitioa controller* have "learning capabilities" to cope 
with unpredictable chaagea in the aanipulator or eavironneat parameter* such si th* stiffness This ia due to the 
fact that th* controller gaiaa ar* adapted rapidly on th* basil of th* maaipnlator performance. Tb* low 
computational requirements make th* proposed coatrol schema suitable for impl *m*n t a t i on in oa-lia* hybrid 
coatrol with high sampling rates. 
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